float64 theta_ref
float64 dist_ref
int32 robot_state
